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(57)Abstract: 

PROBLEM TO BE SOLVED: To highly accurately detect 
the occurrence of a collision in a short time from a 
fluctuation in joint driving torque generated by the 
collision, to relieve interference force from an obstacle 
at stopping processing time after detecting the collision, 
and to minimize damage. 

SOLUTION: Torques T1, T2 and T3 to be generated by 
respective motors at collision nonoccurrence time are 
anticipated by an inverse dynamic operation from a 
position 6m, a speed 8dm, and acceleration 8ddm of the 
motors detected by servo drivers 21, 22 and 23 for 
controlling the respective joint driving motors 11,12 and 
1 3 of a robot. A difference AT between the torque 
anticipative value and a torque command value Tm 
actually generated by the servo drivers or the joint 
driving torque calculated from a torque response value is 
determined. When an absolute value of the difference AT 
is larger than a preset determining value &epsi;, it is 
regarded that the collision is caused. After the collision, 

the joints are made to perform escape operation to reduce the interference force. 
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4ifc«0»*&. ffiSfl^T1i>5r< b/^k tTV^4^ 

[00 59] ki^)f, h^tfckfcLT^WJ** 
^^ffiLi3k-f4*^. ^§V^^;^^* ^ f&^oTV^T 
^-WcW^tTv^ktiW^-^v^k^SL^ttix 
tf^^v^. WW*t*#«:M«IIE-C»< k#(i7c§=5rh 
)V?tPm*tih<r>X\ hWtfimtzJzZKtcitifr 

ht^->xm%t%.w-thmzte^fr%\.\ iot, * 

*Bfa-f43i«lS-S-^4^t^ : 5rh^^«±M'o*\ 
^4 b/W^ k f± k"c7)SS* > (t?iix'r ^ 4 ^SrfficSf 
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[0 0 60] t-f. -tr-.-K F 5 4 ; N'ii* - ? OWShiM 

dd + c {e-e t ) +g (6?) ■ gSrifttrafcfcfcfc: 
»ffl<0*-*a^t-*l«V>hfl<?T, , T 2 , T 3 

[0061] mjj*m*b\t. n^-y bco#ro^fi 

■ • • MJgcOtfJifc. n#-y KOWfll^?.*-* 

<0X"h h . iWiWWj16»«LCJ:Wf. IwEbfc(l) *» 
f> (4) <0 h^^S»BHco»»*jEWt: : faW4 - 
T* 6 J: 3(2*6. 

[00 6 2] ^WU?fcJt«SfU*f*tf> r * 
IX' 9 . W h ;U 7 tf>£#* £ WUf»£ t ? V >6 d t 
[0 0 6 3] Ti =H ((9) ■ ^dd + C (6> • 0 d ) + 

G ( # ) ■ gfcfHW*(cafc9, *<on#«yhffl**> 

N ■ m C^x-hf ■ •Ciiffc&Tfc.kV*. 
^^F^W^Ml^^ (N • m/A) Zftn 



mti^mmz&^xnm 
izmixmttiJizx^kteWd&x'h*^. 

b0nNzit&—$l F2 0#tfc«£;fu WTcOr-^^" 

A'2H3yhn-5 1 3M1 ^E-?cO{iSf£?g<9m 
[r ad] . ^-^jffiffifcgfld m [r ad/se 
c] . ^-^oaifilKJES^ddin trad/sec' ] 
tSXV^-fWhfrr&ttTm [N ■ m] T'S>0. 

[ r a d ] . - WvtYcmVA V KpptJi If 

[006 5] «§gcO$ttJ{i. ^-#b'5MA'<r>7 4-h' 
A'-y ^*J«36*frfeh."C H4RS9 . 04 \zm 5ocOXf 

F2 0$r^tT-f-*'H7-f o#<ybO#IHI 

h£XCD : Z-9l<zm,X' J nhtih . 3o<0|!SlflSa>4> : 5:& 
n#y hcoi§-£T (i, ^r-^Wfig ■ 3£g • Jn&K0)JE 

tif^(H)^v^L(H) r&SfiifrfllfcSrS. * 





* a 


» fit 


(H et 


e m 




r a d 


n (-3) x 


e d ra 




rad/sec 


n (=3) x lff?iJ 


0 44 m 




rad/sec s 


n (=3) x 


Tm 




N ' m 


a (=3) x iffM 



0 dm = [ 0 4 m i . f dmt. f .ms 
e»ddm= t)ami, 9 ami, $ am 



(1-2) 
(1-3) 



T m = | Tmi, T mi, T 
[0066] *>%MZ. mttt&&SK*.* 3 k IX^ 

itK *fflpMWf>!> ixn>2 x-mmz> z t tfx- 
n=i<D^mm±ii.^mx^tK m& 



J 

/c2^coo^-y himmLxm.mm-i^^^m 

ill. i> cot' J> 6. 

[0067] kZ\bX\ Tz-tk'aXvym'BUt. m 

mm^irLx^^tiim<-m^x'hi. *<?>tz*>. 

5^(1-1) *V^t(l-4) Dt''yhW»5T'W{4a- 
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mm ■ immzwi.'g.-th<mtfh & . mmznnh m. & . 

■ mm ■ imm^mmc^mzwrnviv^it, %2<d imi 



E *t 




# fit 


m a 






mj8«j©&iij&s 






9. r 






rad/sec 


n ( = 3 ) x i nn 


T c 


a*' -y 




rad/sec 2 


n (=3) x if?M 






N ■ m 


n ( = 3 ) x 1 m\ 


r 


a** 






n (=3) x lffW 


9 


r 


6 r i . en. 




(1-5) 


e i 




0 d r i. fl d r 2. 


.„.]' 


(1-6) 


0 


d r - 


fl dd r i , 0 dd r 2. 0 dd r » j 


(1-7) 


T 




| T Cl, Tci, Tci] 


(1-8) 


C 




[«.. ... cl 




(1-9) 



[ 0 0 6 8 ] IS i KfflffcWfc-Wltf, -tfifcli^U-io) 
&v>Ul-13)T*3*i*. fiB • 3$J£ ■ MKKov>T 

s^-atmitimtfzmtimwmnmtKi, zz 

Or, - 6 rai/C i 

0 4 r I = 8 dm/ t i 

6 a r i = & ddm i/ C i 

Tci — T m i • C I 

[0069] wwu^uoffil • jSS ■ JnapJKrfetffc: 

n^^^^saa&^^TVKH, c, g> caw 

T = H ( 0 ) • 0 dd + C < 6 , 

[007 1 ] *(2-l) tt, r otf-y M¥- 

Mtti^AtfK? WUJWf-j ■ 1989 

^2HioB^ffj ( vxrmM it^i) izimzti 

TV^ 0 -e^iill. 3C0 C4] Wi. HQftcoSi&ft?^ 

mmi-zmwm i < mznx <dx\ z z t« 

5^(11.28) b%&i)\ •e«0^+^ftf*^3U T K (<6B 
Ufc* a tff « t n stf v h 4 ^ fc ^ K 



X\ xf772fciJ^t(i, ^~9v^)V<nm.- mm 
[*7] 



(1-11) 

(1-12) 
(1-13) 

[0070] uifivYmm/u*-* (Wittaiss 

S Wl^TJi*(2-l) fci OaWC&^ifcsWai^f 

[15:8] 

St) + G ( 0) ■ g (I-l) 

Zb£X->"C±S&)&(2-D mhzbtfx>%h. 

[0072] mmnviv*** bms. \m.^min 
x n^m^nwnnx-h o . o^'/ hw#w»wima 

?(C(±n x l W*iX'fo 0 s o^v hcO#RISi5«oaiSt J: 

<o$iimmti£v : 3V*vj}cr>mx*£.iz>b)U7 
mjj'miGiinx3'mix\ Mmmsww* 

I,Z£ ^mi-fh b)V7 fcjjcffctfrC**. 
[0073] «ttff?l|HKo^Ts 'J?lPtL<Wxl. 
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[0074] fllttffMH , tttt^jCiiit/S^fi^JG 



[H3] 



12 * 






m * 






kg 


i 


m c 






1 x 3 


I 


im« cats * n 4 u > ? conttf- > v a 

r Ix - 1 x y - I x z-i 
I - - I x y ly -Jyz 
L - 1 x z - I y z Iz J 


kg- m ! 


3x3 ?t5'J 




ft 5 'J >9<D&Z 







[ 0 0 7 5 ] #<J >9<n&M. ■ S'W4S • fltttr^V/l' 



{4S- JUS • JP3$JSc03otM7JjPiS*gk*^, #W 

(2-1) *l4tiEtt<0»*fc»-3. 
[«4] 



e * 


*S I 


* ts 


fl K 


T 


B89HC f££-f 4 h;Hr 


N • m 


n (=3) x lffjij 


e 




r a d 


n ( = 3 ) xl fin 


e d 




rad/sec 


n ( = 3 ) x 1 frJtj 


e d< 


P*y MH«<Z>ftIiiK£§ 


rad/sec ■ 


n (= 3 ) x ififlj 


H 




k g • m s 


n (=3) xnfJ9iJ 


C 




N • m 


n ( - 3 ) x 1 ft » 


G 




k g • ra 


n ( - 3 ) x 3 rr*J 


g 




in/sec ' 


3 x 1 ?r?!| 











[ 0 0 7 6 3 ^McfcftSntf'-y h<D«fi§^ 

i , myj , mzi , flHtT^V/H x A &V>L I Zj 

i±. s i commmmz£wmifr->% i + i ^w«f 

WBfft i i <0W«t)IISS*i& 'J 

yycoW*. |s]t<yy?ofi'i>{iS, |si[;<yyyw 
itttryy/i^-e^ft^-f. «fifyy;Kos 

a»XlRlwMi3. SKSKRHHSfvO* 
(*(3.38) *#Sfg) , ^ 
[0077] JJSLfcStvfiMRJ JrtMitt'ryV^** 

r t izwi r> %xi y y ^aauRojg*****, sjne* 

id rn^'-yh • ^tr^-yj an-Ht MS • 1989 

^i2^ 15 Hf6fT ( arm*® 2 1 v ^ ) m 2 . 9 k 



7 2 km3RIS1573 lzKtflV>7L 2 CtJV^Tii. ^ 
2RMtWEH£4"i:^]SjSt L'C»2IHIift:W'3 34.<t4 

JSTrtlfcU z*rttr»2l«B«>liI«5rrtI. y^m^ 

[0078] <xt^ mfy 1 {i-®icft*co[i]iE 

0<O3x3<OSffl?}TJ!l"C*43*(2-2) 
[^9] 
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- I x z - I y 2 



[0 0 79] 4fc, yum^x-stbbtL, 

WKo^h'J^) ?>[SI9K<$tsJ:tfik*>fc:<S 

I x - J ( y ' + z 1 ) dm 
ly = ; ( z ' + x * ) dm 
lz = ; (x' + y •) dm 

flc (n^b'Jy?) *n!!BKWtff->TV^k*, * 

Ixy = J"xydm 
I yz = fyzdm 
Isx-fsxdm 

x, y, ztt. mfewjyfsmm&mtLxm 
ii , m 2 ntftctq Ki^xhtitivy? mm% zvy?L 

H1I HI2 II 1 3 
H= H2I H22 1123 
H31 H32 II 33 



[SSCIO] 

(2-3) 
(2-4) 
(2-5) 

mil] 

(2-6) 
(2-7) 
(2-8) 

[0081 ] frfc, flltt, &ttfc itfSfloffTM&oSf 
[R121 



(2-9) 



Git G 12 G 13 
G= G2I G22 G23 
G31 G32 G33 

[0082] £(2-9) ^V^«(2-11)<0««JSH»±* 

3£^$ftftA-5*-?&4>tfKWffiffit<9. WWS»K 
e — o t 

8 i = 8 d r 

[00 83] Xf77'3tH, C, GW^ISK 

fifcifct, £(2-1) 4><0*ttOfflil1IISSJnaEJK<9d<i ! 5r 
bhhWhhtiK HSWtan*'/ hORiKWfcWK 
[0084] Xf774Cfc^t, *ftWt£(2-l) X' 



(2-lD 



0r. TO&gJG^d r *83fcorfc < <? . e A izW. 
W*, £(2-1) <t»cofltffitr?iIH, ttttfT?JCtiJ:tfS* 

[IS13] 

(3-1) 
(J-2) 

?v72T$tobtVfzmKtitBKJ&f04i r ££(4-1) 

S45-WMjTC0ffi^h;l'^T&. £(4-2) X^fflt&Zb 
tfX'ZZ. 
[»14l 
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r + C (0 r . 0*D + G ( 0 r ) • g 
(4-2) 

I T (4-3) 



[0085] XTvTATg.tiiUzWgtfMZiX^ti: 
\,^lZvX>yb<7)mmdr, 6 d r, d u rX'M 

mztzMzm%m®<?) t k . -y r 2 x- 

A T = T c - T 

4T - [iTi , ATI, A 

[0086] tBStffcWtfr. h^i^fTc k^-si 

fig T k (iH k ^ fc*t£ L < , A T * 0 k & £ te-fxh & . 

I A T 1 I > £ I 
I A T 2 I > £ 2 
I A T J I > £ 3 



[&15] 

(5-1) 

3 ] 1 (5-2) 

5K(5-3) =5r^U£(5-5) CD3kttt<D^-ftifr-~?X'i>ffi 
[K16] 

(5-3) 
(5-4) 
(5-5) 
(5-6) 



82*1 


« a 


* a 


m « 


AT 


h * > t ami t-^j- 1 «a 


N • m 


n (- 3) x 1*7*1 






N • m 


n (=3) xlffSI 



[0087] httMZ, £i (i0UfcfO. ITci t>*> 
tltf+ftX'hlZktf$>\\ WttZltO. 3T Ci fctt 

^hh t\ %(7)b%x"i> 3mmia±. 

cr>h)l? tfSWtfilfUSS k * £ fc Kfc * *>HT , 
»Sffico^-ca^{4B«S(c i h A* left 

tftMTWitf 0 . 8T Ci tKlttfiEltCtSJ? 

otitis k, *f^««^«KS«!aj»** < i8aci*i± 

[0 0 88] £is\ W^«£i liffl£LTtS<kv^fc 

SrTtf . 'h§ W*Uf±tf S b^itzi.? taSflBOS^TIfi 
k LT < i k t 6 . SDMjS^f *±Jf T 0 . 
lTckv^fcJ:3£LT8<kl^t^a}£ffl&* 
t < . flniM^ < **offi3[<o k £ o . 3Tch^ 

[0089] OhJOiftBB^fe^S <t 3 1, otf -y htf) 

m-izt^'o^xcom («^) «r£vW£k# 



TS*J:3fcL"0*. WtfWKUJWC. 5^(2-1) # 

[0090] -t-sKH^-f^! , 2 2 , 2 3 KA:ft§ 
SfifcrflNK** (01 £#88) #>\ f^+fc&oTli 

[009 1 ] *«wcffi*ff5g«iaii6t Jfitf. 
k & v * 4 o T , 4«5r < k t n * <y h 0 MVUZ 

fttt&mmcommmmmzmmzvtzr) . mm 
iz%*mmzm-fiztm&miz'j?zc<%*). mm 



(£ 3))0 2- 283276 (P2002 -$m% 



n#>y b >J y?CS!fllt$<fcBJ*fl:< . b 'J y? 

4. 

[00 9 2] HUCfcWCtt, "?-#b*54 

ABES. t-^coimaa^fcJtft-^^b^lB 
foh<DX\ t-^F7^^^3ybn-7Mi 06 

mi iizm^xmmmmmftLxt-fnmmg. 

j£gtf>*£3ybn-5^ffiteU HwWrVtf«, 3V 

b o- yx-mn J: # txm&nxmmm 

i f 2 ozititemmnmzmnutiz 
taw*?**. 

T c i 1 - T n i • C i 

[00 9 5] t-^^yUXDCt-n'**^ 

- 9 <n=*y&<n 3 ^nocoffl izfflxx v> ( fcTFffl 

*>4**wtse i „ i k tfTcf h . 

[0096] JMBEW^*a^*^W(MW»t 

i ««- -T2 • cos(S ie+ « / 3) • 



[0093] JJELfcttCli. «aAT**fc*£*fc 

a»«rt^«»ta£^< b/i^TOWfc* ?-*b*5 
fcaawLfc. u>u -ewb/^^fit^^-r, 

[0 0 94] 07 J 3 £. 
, , 2 2 , 2 3 -C^^^b/k^^fflTmi fcJEfc 

fc**fc»flifcM>#7'95'tt*Dc*-*i l , 

1, . 1 3 l:«Wt-*'AMP2a, , 2a 2 , 2 
a 3 *»ib<0|HlKt:m8K«iaj»2 3i , 2 3 2 , 2 3 3 * 

■ mfcLTf#*:b;t^JE?g* («Ofc)]2*VCV^b 
)V9) TCi ' MM**. *EUfc*(l-l 

[*17] 

(l-13a) 

^ftfi&tt, 82IK ■ 1990^5^ 8 B^ff ( filTStffcfclK 
3k^d) <7)ffi4. 2XftMlzmW2tiX^Z>. ft&W 
KI4S:^+<05S(4.11)T*$*i4. 5^+^ iqa^ 1 !^ 

wwwfcffla-tsfcwr, ffi««i ua . i 
<r>wme lt i <omm$i i , a #W6-i) "caajsji. 

[&18] 

t », + ^2 ■ COS ( 9 r«> • I u 

(6-1) 



[0 0 97] $r*s, m^tfx.ottfflKli^tfXfrifeft 1 

* 4 a* . *e*«tx y n - ®m i m^imco j o t 

£^-?<0ffi*f8S(Pn m^tri)^ *<6-2> T» 
ffiSft*. tWftfc{i7?S/U*DC*-?tf>u. v, 

9 e rev = mrir/ P n 

[oo 9 8] nya-yt>>t><r>i£l}rtivxe eZ%fm 

360° CffiStSiy^-W^X^iee,,, T* 
(fcU -etOfc^^0S:<9e rev XlfcLtzh<Dl,Z2nZ 
JRtiifcCioT, «Stf|0 ra ***K>S>*i.*. JWfrW 

»„=2ifMOD(0e, 

[ 0 0 9 9 3 £Lh«*(6-l) $rV*L*<6-3) JOgtUS 

0. t-^^RKaj^L-cv^b^Tn^wajsii 

1. b^^JidRKt W:*2&b;l^tfrtSffc£b/l^T 



m«3 6 0° kOrl). xya-nilIi|B^O«AVWX 

[^1 9] 

(6-2) 

[»2 0] 
A e i.. )/ e e r«. (6-3) 

[ft2 1] 
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[oioo] uzwitzummtx-^ m izmz 



C5-4) 

k&oT^fto 
[S6] 



se ^ 


JS i 


* & 


It 


Tn 




LN • m] 




i .. 




A (T>*7) 




8 ,. 




r a d 




i .. 




A C7>*7) 




i .. 




A (7X7) 




em,,. 




P 




Pn 








9e 




p (><;i,x»> 




Kt 


I- /U 7 


N • m/A 





[0 1 0 1] Srfc, t-^^^HtSDCt-^O* 
^Sr*tix(fJ:V^ 0 i«J:3fc*-*tf>tWjM'?*lft 
Jf^ttftS/WLh-fft. k Wt, i«a[MHcb^? 

usa* $ n>sr v ^jwbs*** airr uzmzviv? ahhb 

[0102] Hl-Cti, ^-#F7^>£>ft^-Bffc 

■ as ■ iifiw»BMtfflv^a»*isawM-* ± 
mhw±w%.izxhzx'\,zm^m.titf&h. M9U 

ajtftk^wsj^ftft^-^fts ■ as ■ inask 

LT . imr~? coff4»f^<OJtfttSlW LfcBWfffiH 
k -ewMSWJB^ fc k K LTtt* LfcjftKtJ itflnfiME 

[0103] *-*#v • as ■ mmxm 
wz\*h MtmtLimnmx'ftfrh \*?x-b o , ift 

* LT iJ < i t 4 fc <nian.£&J < t> WTft 4 . 

MSA^^-^T'^-fft kMift b;w? 

(DX'foh. 

[0 104] ZcOtzMZ, ®9coayhn-7l 3 F^CO 
(BWrn^^ACtt, Hlt*tfcft3iifWP2 2 1 til 

mm&3 1 6 , ms&^n 1 7 tani-c . «p wr k 

«on#7 b«WSiHiB#^n*:>y hmflfOjSK ■ »M 
fcfHTtiaK ■ JuaSft«gP2 5A%Jn£*rCUft. 
[ 0 1 0 53 **5. T-^SE*Sl8*>fe-9--#H5>f 
0 d = { 0 cur r - 0 prev) 



A 2 ^{ia^ft^cottJTJ k ffiirt¥»*tf>fcft*>T 
-*W2 6c0^kwrat^WIS^koT*3<* 

? a ><<x<nm$mmz\m^h k v^fcusfc-riu* 

2h3ybo-51 3k«O^T-^^0ro0*t^ 
*<*0. fflftcoBffltflSMSftftikti&ft. 

T<-^yy>^z£hmr^*?^wmm.*x' 

fc. Dljilf-Bg|52 2T'^*«ia^^tTPISffcOfia- 
as ■ JuaiEfcfWt* i k d^ng-ciiiOT, i<o^r 
ffilijfeow (01 *#!H) kH«t. «rtffi£i»r-t 

hmmzzttfx'zz. 
[0106] m^mm. -y 

&T-nzMlXV-*} i 7-1^2C07 <-V^v7ffl 
m i fffrtlX^Z>V& t ) . 01 0K5cf6OOX-7 l -yrt 

tftaWi. 3Xbn-5 1 3rt^rn^5A-C*4f^ 
tiilVl IT'fffcftft^kte. mcoWkfl*ftk^ft# ? 

[0 107] Xf >y7°l lttJ^TIi. n^-yh 
#|JWp"<0ffiI ■ aS ■ SnaS#, ^-Ff^? 1 5(c 

s. jw*wt=i±. as • Jnasft*gi52 5xmmmmz- 

1 0 1 0 8 ] iiT, n^-y h«-R!©coaS ■ JuaSS: 

Sn^RffiiffiHSr^currk t, KfTOWt^ttftRliff 
fi®£0prevkb-C W^fcttft^TOOaS^d 

[E2 2] 

'SB.Pt (7-1) 



(*1 5) )02-283276 (P2002-"«S 



[0109] 3Bja«!-c»ajs<iJti»iiia**<9d cun-fc s. its, ^jotfc(ti). #wMicoas. jnauBi^ 

L . itfr<0*IIBW^I«W^t <9 d Prevfc , -ffti 0 fc . 

l^fctt*#ffl»<ofln38S0dd aWWH^WHTSft ^ix [ft 2 3 ] 

0dd= ( dcurr - 0 dprev) /Smpt (7-2) 



[0 110] Xfy/l l-CUCfflLfco^-y h«-W«tf> 
1) (cfciJJUHU "9-->Kl F2 0*^LT-9--#K9 



H 7 4 ^X^fiSf^fflcoiUm^r 771 2 T 

fffciX*. ^r±3. (9c {±n^-yhTO«fiBJE^ [ra 
d] ^C0«{±n ( = 3) xim\k%l. 

m24) 

J I ' (8-1) 



(8-2) 



[oiii] Xtv7\ 3X^tY)V7<r>W&<rM.?>-Thfr 

tSt-?«h;^^lTm, , Tm 2 , Tm 3 £^ 

Tc ■ [ T c i i T c j , 
T c i - T mi • 5 i 

[0112] Xf77 1 4?(4S8IMj^*tA' 

(h, c, g) mmzti* xr-xri 5Tmmjv?M 
mzt&hfr7 j f-mwj s tim.zti&. xr^ri 6-tfir 

ILt fc a 0 O^IIfc J; ->-C«SCe«Bl*«flrS*i* . 
\>*>bA,* *Of£fcfif&^SffjlJWi?T*>ftl>. 

[0113] 09wwt:fcv^i±tia • as ■ iaaLft& 

^£kfcfcLT W1^7£^SILT4d , 9, H^Jfcgffifc 

fcWflH 6 «SStftffi»*t>l*Lt*4»: 
fcfc&£« 0905«|JS£, -t-^h* 5-^^*2 1*1 

mm-tiif, -t-x v 3 a *<n^m&mm * - 

i><£fc#-t'#£J:3fc&&. 01 Hi, H9<ofif)&fc 

[0 114] fca^UBL<3fi^4fc. I29<9*§£, Hi 
i a fca«*T- li^h7 4 — V7*V—¥ 

■t&zt a*T*# a . 7^-h'7t7-h' -mar, fis • 

as ■ im&<ntottti s &IBi<?)J88b£&&ffl££m9<?) 

taa ■ as • mm&tmmzmmztiiim ■ a 
s ■ mmmb^mmi-im^zh'o , 

L & < & I. fc ^ o fcdtWI J.Uamntf£ t « . 

l*»u 7 <-V7*y-mmzi:tni. 



Tc i fcLT4^^^a« 
[3&2 5] 

T c 3 ] ' (9-1) 
(9-2) 

[0 1 1 5] 01 2fcli, aifitMW)7-f-l t 7*7- 
KfflilcOWfctioTaSJE^^fcawJ; 3 CfflaW 6 
c . m3&r<r>7 * ~ H 7 * 7- h'fflR 
tff iff . ( a ) fc ( b ) *JUfc^-C4»»6 J: ^ fc. 86 

aro**a«&*fc» uatstr fc < mmm 

(i*gU&&)ififo±-t&. ztiipb&frmic. 7i 

- k 7 * 7 - H-mtf * 4 a 7 ym^ < * o . fcsnfc 
i/t. fia • as • inaso^inigfcffiftTjfi^i, 

Wfc&S. 

[0 1 16] 7 4-F7*7-FffififhrSfcftB 

7 * - •/ y kpp<7)$# lisr-fe 6 as 

Ii7 4 - H 7 a v- H Wfc$S< WT-aS^^Bafc^: 
3*14 . fc^aS/itfCti+^eBMS^aj^v^T 

easrttfct/iasMWt^^Tfco. ;ns:as 

C07 ^ - H 7 *7- Hfc«U-CHiaWt«BBS-li:'C*i < 
^fcfc=5:4. 

[0117] *>^fc. ^(2-1) Ut J 1 KtflfVvtfcO 
•C** kRflUfc«4. ^fc^WM^fctWii-ffc^ 

ffl-f&*^&*fHfcM^fc*»tT*4. tit, #38!H 

^n^fc^^jaa^«ansrff3ifcfc^4^, 
■b y-^^iWHiri* 4 t>v—7 izn Lxmmzmz 

IX^Z fc & fc*Wfl*>Jl**Ett3tf * i fc * s t-^ S 
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[0118] l;Xk£X'im%<7)®ft1i&Z%^zfiK £ 

■th. *<osaa<oattt. irFcok£9T£>4<, 

^ LTfr feRfc^UflHtflBi LT V^4 *>ttT» 4 

[01 19] *£T\ ntf>y h*)ffjfcJJMW:*iVVCtt, 
JMWW^RKHPi^fi* J: "3 <c« - k 

y b SrPRlR LT#±3*4 i k#T# 4S«W b 

^®fiW£ LT«*£ft/N»C< i\ifc*>4 kf) 
MC4o fcffihfflSlfcfT 3 <! k (cf 4 . 
[0 120] £^tfjW!ia{4ia20k£*?fc*h.fcJ: 

3 K , ff oh L < (4ffi3$T*»JV BMHtov 14, 
^EP9 «4 o ^rUSBK 4 4T***Wfe»f *#W^H 
KSUfS-CS 4iWW*'t4 £ kT* 0 , f**«»«)JBT 
W<tz 4 a fc , ittWWcU v t> ■srflg'Sr*n»3r 0 * & v * 

•y b k PtWft k <oiat:*& 3r7J#MJ3-f 4 .1 k £=5r 4 k 

[0121] JUWWrtt. «S»lBI"C*fcaWi, 4PE 

4b;U?*f6£3-£ ! a:^4'3fc:, ^-?co3&£bA-?£ 
Ml&t 4 £ k t=-f 4 . M*. H #S 3 Rfflftt jL * r> T 0 t 

T"4V^. ^jMitf*W|^iffi#t[IllGU ] Jy 
9 mmsfrhW v k Wrf 4 . ff 3 £ k $ < » 

(f4 £ k iiif , g 2 pw«« 3 mmzm±-t& 

*^ tftfetfljfflFcoSte^ibJ^RRtflli £>ft4 . d ?)4 
*>* fcttffiv L T v >£V OTfcov vc«4 . * 

Kafe*>i* (caw &m*zmi* o tt&hox-b 

4. 

[0122] **)ffjfc*!i3*)±Bli, MfliOofeffitk 
L < t4ffloST»ft LT V > 4 TOJ> 4 1 ^iflHtfl*** 3 V > 
fzibmfEW±lz&m% # s ft* b )V 9 k JfcR L X + 

lt wr mtt zz^.ffigizxz =rm tm t>i?t>ti& 

4 3Ktfcikt*S. 

[0123] i^;, «^?MlB*^#W«5?)>£J£k£?iH 

s/MicT) h/i/^fit^TOrk t*aj l . -e^ft/i^ b 

;W ? fl & b 7 A > S'l*ltf0 h IV 9 StJRgfl 3 tClS^-r 4 



jt«?ij^yKpp^ona#«x.4 4 3t-r4. w:4 

70Jffl^4 4«arMaS:fi : ^-ti:4c7)T'S>4. 
[0 124] S^tl. 0#>yK»5ilff*ffjkS*4fcft 

^fia^3WiLfca. ±xnffiM&±mffi<7)o-t?(7)frkiM 
* t ^m^>RWiS«0»aff jh^iat: fc 4 £ k 1 4 <0 . 
±fflL7tatf»^^^03f)^R|l5tfcV^T^-r'# 4 4 
3lrr4i<9T**>4. 

[0125] «5&6«»aj5flT t>a«J4XT>y7*ttt:0 
»4£k^T'#4„ Wm&WcovvCfc. -9--#H5>f 

A'£7)««^T-'j)4 : &-^ea^mA^tt4 

T*4H^iJc0ft*{±^k=Sr4„ £*U43«o^-y b 
<0S»tJ:oTSfl:-t4^^— ^"C*4. £«ff^H 

*W^SrlHIL» >Ic7)fflJiLilC7)^;^7* { ^4t'5rV^4 
o iz^-^tHf} hfr? ^MR-T 6 . £<0 b;k^ {U^MRR 
KHli, HI. 09, 01 l(c£SftfcM^WR«tf> 
fS^gSS2 8S:^LTff^fL4„ 
[0 126] 02<O4^tSS3RMf73 (4ftV^V^V^ 
*»SSlWI57i km2MSff7 2 »^T^4k-t4k. 
m 1 TOk m 2 UWffcov ^ 14* Otltt^l $r$iJ»-r 4 « 
(tWifc«W*# Or b >V 9 mS k * 4 % 3 BBBTCti 

«tt^i4/hs <^o-r«^^ ; 5rb^7 1, m i ware* 

*2H«SCitimitf/hS<-rJ:v^. *Wfeft. S3M 
15 7 3 £KMt 4 1 - 9 co b MRH fcli'hS v ^ 
ISS^^. m3MI5(Cji^$ix^U>7*>'miRII5, 9t 
2IWi5<0»St4o'r«KU"Ct>, m3M8i5(4fS#t» 
5§(i4 4T*^1 tf 4^l*I^»f'4 £ k #»rffik 5: 

0 , ffSSt 4 WCk Wfcth £ k J&f-C'^ 4 . 

[0127] «TIC ffjfc*H«ftf(c0!ta^4. M$ 

t^v^-fix*H0»^ajM;4 o«se*«iajLfca, 

m\3<r>A^<nx^-<j7>frht£h>)m$:'fto > 4-f. x 
b^^€S:*ai-t4. 

[0128] fK^"^ii^t«ffi?riia«flw 

Ob^^ffiTusab^*, «(4-2) fc3BBtfc^(10-l)*»fe 
»*-t4£k* s T'#4 0 £^b;U^ttTusab{4. »^?r 
#ih$-£4 fcftcojjo«a«{:«fflTS 4 t,<0T, MJS 
fcioT4t4b;^kI.ttS*i4. *^Jt44b;b^ 
^Wtt^4 4 b;i^7{4astffi : i¥-r4 itfrc* 0 , 

st44 h)i? Mtmzm&%titAtt%e>%^hfr?x' 

J>4„ 

[0129] 5^(4-2) i^mixmzx 0M*-T4 b 
(ttttb;^) fcSatiOiHfc-riWi^kfcgi 
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x . mmzw±cr)tzth<7)®mmm£mxz & v>v?tf 1&2 6 ] 

Tusab - - sign( 0 t r ) • Tmi- C ( 0 r , 



Tusab = [ Tusabi 



Tusab2 , Tusabs 



(lfl-3) 



; o «5 1 

[0 130] «r*S, ^(10-l)+<Osign ( <9 d r ) fiflMf 
£&tf)T^4. Tmax J£g-*-***?fc£U#4S* 

"tli"?4 LTttBLfcl^i: sign 

(dt r) J«*Lfc*l5ei/0*4. «ft«M66«iE-Cft 
fttffl«JifiM»««Hlk ! Sr 0 , ft« h/W^^x ^ix 

^tfovvo^ScO-CftWM^fcfci. flOMMEtftfiT 
vvMtf ]E<Oji8ME*«iHBk«r ft x ft =iEfc £4 

j 3 cut***. auE(* d r)t*ti,T«f 

[0131] -sign ( 0„ r ) • Tmax 14, 

T aaxi = T mmaxi ■ £ • 

[ 0 1 3 3 ] Tm maxi iMUi t«»WHttr»6 

htmi h^m&mz^-ihxa<^h^x^ 

4. CtfM^Gff?iJt,a^*«l{fi^63ieTfWSii"C 
J3 0, *hfclcfHM-*i«?U*v*. Of* v> 

3$ (4-2) rttr>fcfcW£*0*il*->T<*UfJ: 



» sigi ( 8 d r ) = 1 
! sigi (Six) = - 1 

mmzx^xm&ti viv? tmMzx^xm&tz h 
iv9 m\% uzi>cDx\ ztitfmmiizm&ntzMzm o 

Z\ t tfX'Z 4^(10-1) X'$l htlh Y)V9 Tusabtfc 
4„ 

[0 132] a<10-l) tt, 5$(4-2) <0H ( <9 r ) ■ 6 Ai 
r£Tusabfc. £(4-2) <7)T£-sign (6 d r) ■ Tma 
x kJfS*ifcfccOT*4. *tJ. SB i WMS*>**i4tfj 

&ft*Wl^£Tm max£-f4i:, Ma[Jt£#J£LT£ 
(10-4) taffi't* 9o£X'i>%<. Tm 

frfl c sfir 4> Wzm.?>'m\ G (i , ^6^KO#BW5<offi 

gfc3a«*^maj^T&4. 

[&2 7] 

(10-4) 

A . tm L r t> J: V uWflBfclW- 4 o £ KtHWt* L 

fc, «E7fc»lEl/tfe<. 
[*7] 



JB 9 


* i 


* tt 


® ft 


Tiax 


MI5A< Hi-fi's ft* h*? 


N • m 


n x 


Tusab 




N • m 


n (=3) x iffn 




■e-?*<Ul»RHte<£ft*h^i' 


N • m 


n (-- 3) x iff*) 



[0 134] ^f772 2tll irft££ffjLS-£4fc*> 
^«>5r#MSfi«b^^ffi* J *tii^ix4o «afc«k 0« 

H ( 0 ) • 0 <u = T dec 

c o 1 3 5 ] t z\hx\ zmk}im.m\mz^x 
iz, ±x nmfw&fffl t adxmss. o taaMMrt 4 1> <o 

h<R5rt4. 1-4 fc, #WHf«JS3t«^dd{±» *(ll-2) 
V$&'r&ZbtfX'$&. ^(ll-2)4><0^ d r 
9 a = 6 d r / t nd 

[0136] ^x<nMm^{n-2)<nnffitndxm&& 
o&mz x t x , jftoaxouMfftc*} v ^ ±ie L/cBtf » 



T V £ «k o T Tdec 4 CI t fcft 

4. 

[IS28] 

(11-1) 

r(itmd(i*jQT'S>4„ 
[»2 9] 

(11-2) 

ft^itflK: ^ t*4 i i: 4 J: 3 £=5r4 cO"C*4 . 
[0137] B^ratmdh L-C. «"C»B^4^ 

<ll-4)=arv> t*(ll-6) Ta# •■/ h £?)RISB<7)SS[fi(t*S 4 
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(5^(11-7) . £*U4, O^-y h(0^Tc0RIt5(- 

?#\ M3W£^f&& WW?Tusab£jS;i3:^J: dC 

49. 

[o 1 38] ##fc'tta^«\ asssiifctid 
mm* . e*w e* *> a < »v ^ t ^ mm * v ^{±- 

3I< »v vo * * WHTCJiiSa** 0 fc«r 4 4 TK:^ia*«+ 
II ( 9 r) • 0 nr/ t od - Tu 
[0140] £*>*<U-3>a»fc, ff±»^«atffiffl 
T#l> WW?TusabOfEHl*lT\ ntf'-y h<75#Htff<9a 

k 5- o Ktr* fMn^ra t «i#*ai?$ * . # 

£(ll-3)fc*JWC, H ( (9 r ) (i, «^&£B*C9# 
MffiftStf r*»fe»aj"CS36»o<9 rm-#l F 2 OS: 

i?l&C* 0 , Tusab{4S(10-l)TtWa»Tt>*>* . 
[0141] ft»WKtt*»< ? 5fHitid*f{'tfc*6. t 

t odi - Hll • 04 r i/ Tu 



[ 0 1 3 9 ] i ffiBPKOSBatcffiffl'CS S WW 
712, 3«(10-l)*»4>Tusabk*ajS<lT^*<Ot, S<1 
l-l)^a*TusabCBS8tt, ^TC0TO*^(ll-2) 

<d j=*(ii-2) co^matx-ti t . *(u-i) U3S(ii-3) 

^J; d CSSBSfU. *(li-3)+w«ttff?dH<o»ai* 
[*30] 

sab dl-3) 

fctt. 3o«MKtft*i. WRfctt. *<ll-3)fc. 
TOrttmT^30^(C^L, ^^JhWrBltmd 
fcJKM-* . ft*Wt:mi.tf^QtWf UWH8Rn = 3 

3 SJHtiLfcat. tndi , tmd 2 , tmd 3 V)tycr>&k 
[»3 11 



ibi + HU • 
+ H 13 • 



abi 



jrj/Tu 
ra/ Tusabi 
(11-4) 

- HI1 • 0d r i / Tusabj + H22 ■ 9iri/Tnsabi 
+ H23 • 0 ars/ Tusabz 

(11-5) 



t nds - H31 • 0 i 



t nd = M A X (tidi. Indi I 

[0142] Mft*wk%^htzMz-mft&mi<r>y 

/W?«Tdec i ,i, *(lM)fcV*LS<ll-7)*»&*Bi3 

^^Mji^jtBtfatmd^fflv^-c, 5S(ii-8)-c*aiS*i 
s. *t>\ Tdec i m±izm%mB<vh>v?m (n 

Tdeci = H(9 ri) • 0dn/ 
[0 14 3] iWjSKl/CJMJ&KfcTdec li, ®^ 

ffiusig tag i ± t s v v&b*'MR0> h /w? « k 

[0144] S(H-DWHff jC<11-2) C0SS<75MI5 
&£# d rfcJ:t;«3affjh«fiatid*»fe. S-WWfciBfl 
=5r«3f WW?Tdec *W(ll-8) t «fc 0*36*6. i:-* 1 - 

Tdec <Tusabt*4. iMiaatf'hS^AMtttfl 



i/ Tusab»+ H32 • edr2/Tusab3 
+ JIS3 • edr3/Tusab3 
(11-8) 

indi indj) (ll-D 

■ m] X\ ZCDMmZn ( = 3) xlffJfCfci. trad 

ti^cowirc^saffiti^ia (sec) *?, fflsui 

[»32] 
t>d (ii-s) 

(=H) A»^Sv^fct7)(COV^TttTdec «>/hS<***» 

[0 14 5] Xr-yT2 3-C(i, If-itfF?^ <2|*!0> 
•yT-2-C^ajt^Tdec {iHHrC&£t-& h^?t'J> 

^LTTO^iBiltTV^W. Tdec $r^-^^A-7 
2 8Srat-CTm dec#*-fr-#K?'f''tob 



(*1 9) )02-283276 ( P 2 0 0 2 -P;S»ff 



[0 14 6]»iW»*Birt4t-^(C*if«ffjl:ll* m) T'&O. *<D«(in ( = 3) xlff?iji;&|>. 
Hfc:3iJ£&±t$-fr*V> j e®*/J>BR^b^^fiTin dec [113 3] 

i liaSS (12-1)^0 <t a k L-r»aj-t* ; k i . ft 

T mdcci = Tdcu/ { i (12-1) 
T mdcc = [ T mdeci • Tmdeci - Tmdeci ] ' (12-2) 



[0147] h%MZ. YJllWimt LT:£(ll-8)<9 
Tdec Wt- # F 9 4 > <fcA o T < « # , Tdec « <£<?) 

vwch^x, mmz Y)V9 mmt & con*- ?x- 

TISIfliTm deci tfAilfefliifcfcfci. 

[0148] l&ntzMzimtliiK Hmi*?e>i rW 

WBrtta^^fe. tid, =tmd 2 = tmd 3 fcLtV^ 

Tm deq fcW-#|*?>f , 2 2 , 
2 3 rk(cJWr6. fcti. f&fcflfcTmdec A £-?-<o4 
tmtXMWK Tmdec d (CiftTBWrfcO 

^Ktt. Sfcofcffift«:«-Tmdec j {CSRCTflSBTtfl 

[0 14 9] Xr-/T24T'ii, #-f-^'K7-f^"2rt 
c0ffiS7 -f - FA' -y ?ttM?4 yKppttK -9--^ I F 2 
Ofcfl-LTOfcSOESfi*. J2Lt<0*??:r2 1fcnL 

2 4 nmtz* *} . mvnzm&m*& o k Lfcau* 
7 < - FA-.y ^Mwt= i s«a«ia*«tf *>*i* . 

[0 1 5 0] #Hf-#F5>f A*rt^F/P^MRR»3C 
14, ffihKi«fiMr*/N»0 F^ttMRjeSft**)?. 

b)i7mmmz&±h)i7mtfi&fcztiz>fe*com£iz 
Tmmmmtmmiz&mztiz zttz 

[0 1 5 1] icoidfc, Ml^fflRfcfctt&Siirtf 
tt-CSr < K PP £ 0 1 LT v ^ OJi . F ^ ? MRttal * 

fi[»D7 < - FA'-^KinM^ifi***^^^ 3 k 1>, 

Kpp*oc-«itfaaafi^«t»KOk«r6. xk»* 

[0152] ±iE*>6#*»S J: 3 c, m&n-rtzifx- 
fmnmi±^ic^z o t-fhcnx'hhbK viv^tf 
mmz$8iLx®mzixx^h<r>x\ m<m^x^m 
m'iiWckbfr?x°±frmwmztiz>. im 
mmn, gzcom%zoizmtitmcDi-%b-hm 

[0153] ztifrWfri «t a (= . ±ia^it^at 



feBwsrrft tuw*»o x v ^fltPMia 
yy; iimnf l t v m mmm*i<n <t t 

[0154] «itf*fiBrt«)»TSCttt6 

L&VM3;tf >y F F /I j6<»*> 0 tt ^ 
Uy^"5ri:"T'(i, iStt**0fc4ofc«rjSTF 

<iz*cDmzmftm? ) ) r-rh^iwsatxtsmi 

[0155] &±T\ IK8«iajaoff 
-^cOflHtt-^yF*#<LfcO. ^-^ttS^Mjl 

t-?^T«WL*. ^?tn>mi>i<\tmMixMmz 
it&zkt i X'l*&i>0)X'fo&. 

[0 1 56] 4i\ ^-^o-^cOffitt^-^yhcO# 
IBL^nx n<oflHttrJ0t:tJJt4*fft5SRk tTW r pg 

littt-^ > F ^«3rifc^ 2 «fg LXton L£$k+& 

hcoxki. ztiiz£~>x. mmizmzmmz 

$ts*-?u-?cr>&m-* y Ftc J: OH^S F/P 

[ 0 1 5 7 ] *■? , 5^(2-9) CO*ttfrWH&OT<Oi 0 

tc^^-s i t tcj: o . mmmzmmmmsti 

^yh (kg- m 2]T\ ^-coffliicfin ( = 3) Xlff?ij 
1:44. 

[»34] 
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H22 + 
113 2 



H 13 
H23 
H33 + 



[ o 1 5 8 ] si i ^m9 $ h utm 1 1 ffymizjmix 
9 mnmkwtmz h x-h i . 

[0 1 5 9] ZZX\ I mi li$i$»£^tH=-:?U- 

9com^~^yhX'ht. a»LTii<ii]!ig*^itt 

t-^VMi, Z?)®mikn2mftcDlfeZtlXAJ)® 

y ht^mm^x. hmizzn&x'h&fc 

^-^n-^cotltt^:-^ y b* J M5iitW2^fg$ix 
X1)mZixX\^<Mi*<ntzfrX'foh . 
[0160] «ttffflH<0*fftB«i*ftS#:C4*4 

T = H (9) • 8<i+C(0. 



mmcommE-ttitf i mi i>§i w 

Ii^flBfcBBirC*4a»S», 5$(13-l)fcJ:4*6i, R 

a*. 

[ o 1 6 1 ] act:. mw&m%&Lxmm®ftmg. 

[|»35] 

) + G(0) • g 
,UZ I ■ sgn( 9 iT. 



Cm = 


| C mi . Cm! , 


e-.]' 


(14-2) 


F cou = 


[ Fcoui. Fcqim 


F C0U3 j 


(14-3) 


13 * 


« § 


* {ft 


e * 


Cm 




N • m ■ sec 


n (=3) x 


Fcou 




N • m 


n ( = 3 ) x 1 ftjij 



[0 1 6 2] JfiSMBfrfcfcWbWjWrOftO. i*it> 

h/l^HOTeti. iWi, 5$(14-1)0>4«BC*;S*1 

[0163] CmttWttttflMR-C* 0 , iflfcjME** 
tftlf. ^SLWl^fc&S. I Fcou lii^-ovWK 



»fcffi<D*fiC»< WI^J*fl"C*4. Cm • 0 6 mt 

I Fcou I bffffltfs zzx-^t^m.V)^X'h 
S. «(14-M45$(2-1) K4«B*iEJnl,fct>WCft 

[ 0 1 6 4 ] ii-C. Cmtt*-*^W£tt*8aM*> 
«)fett« n x 1 m-Ct> 0 , MMtlt SJSi: 

Sfct, ^ d m(i^-^^aSnXlff?iJ-C 
**. &fc> 5^(14-1) *<7)sgn ( # d m) 14. 
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[836] 



0 im > 0 © £ # 
; 0 dm = 0 © <!: * 
; 0 dm < 0 © t. # 



[o 1 6 5] RnKfitfct-^aa^wfiRti-t^ 

5H(14-5)cOJ:dt^SiiS. 
0 dm - e d • € 

?Cm, Fcou , ghttn&J^WBMBXb&fr 
h . ±IB(14-1) dz£-)X VCff jtSPTC 

[0 166] 

fcv M^SrFSSU 

oWWUCIS^ t z k i b )V7 £ SI t x v ^ < to 

[0167] ^#£tTV^v^£#WSi>£iBlrf 

g-a£-M£ko*"yhOffi^:M-?kS:t>k 
Cl/t, T = H (<?) ■ #dd + C (0. ) +G 

m&*v^<nwmmm*m>Lti:<x 
[0168] w^^a-ts^t^ffl-r^-^fi 

a«fcfcT#3 J3fc"WU*. If-* K 9 4 

m£.m&m&mxzffirtt z t m * . 

[0169] iS!ll*^««ttJV^Ii. nt' y 
mcotia&mz]: i)»Jli«T*M^*wrt-nXn*> 

SSrf nX3»fi^ff5iJ**tfii:t:LT^4<0-C, * 
[0170] n x n«0«ttfr*MC*ift**Wll8Rfc 

- 7 Wflltt*-.* > h *«aitO 2 SUg LTJn* LXH 

mi. zmmzm^jmrni-tts*-?*-?^ 



[*3 71 

(14-5) 
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